/**
* @file        RoughAlignment
* @brief       
* @version     1.0.0
* @author      Changlin.Jing 
* @date        2023/7/31 16:41
* @copyright   Copyright  2022 Langge Software Co., Ltd. All rights reserved.
*/
#include "TransformCoordinate.hpp"
BEGIN_SPACE_LANGE_VDR
void TransformCoordinate::transform(Eigen::Vector3d& vec) {
    Eigen::Matrix3d matrix;
    matrix << 0.0,  0,  -1,
            -1, 0.0,    0,
            0,  1,  0;
    vec = matrix * vec;
}
END_SPACE_LANGE_VDR